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(57) ABSTRACT 

The present invention relates to a fully androgynous, recon- 
figurable closed loop feedback controlled low impact dock- 
ing system with load sensing electromagnetic capture ring. 
The docking system of the present invention preferably 
comprises two docking assemblies, each docking assembly 
comprising a load sensing ring having an outer face, one ot 
more electromagnets, one or more load cells coupled to said 
load sensing ring. The docking assembly further comprises 
a plurality of actuator arms coupled to said load sensing ring 
and capable of dynamically adjusting the orientation of said 
load sensing ring and a reconfigurable closed loop control 
system capable of analyzing signals originating from said 
plurality of load cells and of outputting real time control for 
each of the actuators. The docking assembly of the present 
invention incorporates an active load sensing system to 
automatically dynamically adjust the load sensing ring dur- 
ing capture instead of requiring significant force to push and 
realign the ring. 

22 Claims, 15 Drawing Sheets 
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ANDROGYNOUS, RECONFIGURABLE 
CLOSED LOOP FEEDBACK CONTROLLED 
LOW IMPACT DOCKING SYSTEM WITH 
LOAD SENSING ELECTROMAGNETIC 

CAPTURE RING 5 

This application claim benefit to provisional application 
No. 60/104,843 Sep. 29, 1998. 

BACKGROUND OF THE INVENTION 10 

1. Field of the Invention 

The present invention generally relates an androgynous, 
reconfigurable closed loop feedback controlled low impact 
docking system and assembly with load sensing electromag' 
netic capture ring. More particularly, the invention relates to 15 
a load sensing, electromagnetic docking system. Still more 
particularly, the invention relates to a docking assembly and 
system having a reconfigurable control system that permits 
a load sensing ring with an electromagnetic capture mecha- 
nism to “softly” capture and dock two structures or vehicles 
together. 

2. Background of the Invention 

Docking systems permit two struc tures or vehicles to be 
coupled together. For instance, the assignee of the present 25 
invention uses docking systems to dock one spacecraft to 
another in orbit around the Earth. The International Space 
Station (ISS) currently under construction in space has a 
docking system to permit the Space Transport System 
(STS), also referred to as the “Shuttle”, to dock to the ISS. 30 
Crew, equipment, supplies, and other types of cargo then can 
be transferred from one vehicle to the other through the 
docking system tunnel. 

Most docking systems use a mechanical structure com- 
prising latches, hooks and other mechanisms. Generally, 35 
there are two different ways of coupling vehicles together, 
either docking or berthing. “Docking” occurs when a free- 
flying vehicle, such as the Space Shuttle, under its own 
control maneuvers into the capture envelope and then into 
contact with the docking assembly of another vehicle, such 40 
as the Space Station. “Berthing” occurs when an externally 
attached device such as a Remote Manipulator System 
(RMS), that is structurally grounded to one vehicle such as 
the Space Station, attaches to the other vehicle and maneu- 
vers into the capture envelope and then into contact with the 45 
Space Station docking assembly. Docking or berthing two 
vehicles requires that each vehicle have a docking assembly. 

To dock two vehicles using a conventional mechanical 
docking assembly, the vehicles must be pressed together 
with sufficient force to re -align the soft capture ring and to 50 
trip the mechanical soft capture latches, hooks, or etc. on the 
respective docking assemblies, thereby coupling the two 
docking assemblies. In a terrestrial application, this action is 
analogous to two train cars coupling. Train cars can be 
coupled only if one car is pushed against the other car with 55 
enough force to open and then close the mechanical cou- 
pling assembly. 

The following discussion details the primary phases in 
any docking scenario. First is the “approach” phase wherein 
a vehicle moves into a capture envelope. A capture envelope 60 
is a predetermined area surrounding a docking assembly into 
which a pilot or remote control must guide a vehicle before 
docking/berthing can be effected. Second is the “alignment” 
phase wherein the two vehicles to be docked establish a soft 
capture ring alignment with one another. This phase has 65 
traditionally been accomplished by driving vehicles together 
to force capture ring alignment using passive guides during 
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docking or by realigning using RMS visual cues to correct 
for misalignments. Third is the “capture” phase which is 
accomplished by forcing capture latches to hold the vehicles 
together or by “reach around and grab arms” to capture the 
mating interface during berthing. Fourth is the “attenuation” 
phase, wherein the dynamic energy and residual motion of 
the separate vehicles is absorbed by the combined assembly. 
Fifth is the “retraction” phase where residual misalignments 
are nullified and the docking mechanism is retracted to bring 
the mating sealing interfaces in contact. The final phase is 
the “structural mating” phase. There, structural latches are 
engaged to provide a rigid structural interface and to com- 
press and pre-load the seals to facilitate the maintenance of 
a pressurized volume. 

With prior mechanical docking assemblies, the action of 
forcing two vehicles together, particularly in space, can 
result in damage to one or both of the vehicles or sensitive 
systems and components due to the high forces required to 
actuate capture mechanisms when docking. Further, forcing 
the vehicles together can ruin vibration sensitive 
experiments, such as crystal growth experiments, that may 
be performed on one or both of the vehicles. Thus, there is 
a need for a docking system that can minimize or eliminate 
the potential for structural damage and vibration caused by 
conventional docking systems. 

Despite the advantages a docking system would provide, 
to date no such docking system is known to exist that 
provides low force mating or that can accomplish both 
docking and berthing operations. 

BRIEF SUMMARY OF THE INVENTION 

The problems noted above are solved in large part by the 
androgynous, reconfigurable closed loop feedback con- 
trolled low impact docking system with load sensing elec- 
tromagnetic capture ring of the present invention. In one 
embodiment, the docking system comprises two fully 
androgynous docking assemblies. This allows two identical 
docking assemblies to dock or berth with one another in 
contrast to docking systems that use different (male and 
female) assemblies. Each docking assembly comprises a 
load sensing ring having an outer face, one or more elec- 
tromagnets positioned on the outer face of the load sensing 
ring, and striker plates positioned on the outer face of the 
load sensing ring. Each docking assembly further comprises 
a plurality of load cells coupled to the load sensing ring, a 
plurality of actuator arms coupled to the load sensing ring 
capable of dynamically adjusting the position and orienta- 
tion of the load sensing ring, and a reconfigurable closed 
loop control system capable of analyzing signals originating 
from the load cells and of outputting real time control for the 
actuator arms. 

To a certain extent, the docking system of the present 
invention is somewhat analogous to the Russian built 
Androgynous Peripheral Assembly System (APAS). The 
docking system disclosed herein differs, however, from the 
APAS in that the present invention is a “smart” electrome- 
chanical system comprised of a blend of structural/ 
mechanical, electrical, computer controlled, and software 
elements. Further, “androgynous” as that term is used in the 
Russian APAS system means that only parts of the assembly 
interfaces are androgynous, whereas the present invention is 
fully androgynous. Being fully androgynous allows an 
active docking assembly to mate with another active dock- 
ing assembly; two active APAS systems cannot mate. 

In addition, the design of the present invention varies 
from the traditional docking mechanism of a highly 
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mechanically interconnected system of gears, clutches, and 
linkages. The present invention comprises a reconfigurable 
computer controlled mechanism and uses a smart 
electromechanical, six (6) degrees of freedom platform that 
incorporates an active load sensing system to automatically 5 
and dynamically adjust the soft capture ring during capture, 
instead of requiring significant force to push and realign the 
ring. Instead of mechanical trip latches that require a trip- 
ping force for capture, the present invention uses electro- 
magnets to achieve “soft” capture, but not limited to. to 
Further, the present invention also can be controlled as a 
damper in lieu of the interconnected linear actuators and the 
separate load attenuation system associated with conven- 
tional docking systems, which are used to attenuate the 
residual motion and dissipate the forces resulting from 15 
ramming two vehicles together. 

Moreover, the docking assembly of the present invention 
does not require minimum or maximum closing velocities or 
dynamic forces for correcting misalignments and effective 
capture. In fact, the docking system of the present invention -0 
can handle large positive closing velocities and forces, as 
well as negative and zero closing velocities. Further, the 
reconfigurable closed loop control system is adjustable to 
match a specific vehicle’s properties i.e. mass and center of 
mass or gravity offset and operational mating characteristics, - 5 
i.e., approach velocities and angular rates. The control 
system parameters are tunable in each axis to various 
stiffness and damping constants depending upon stiffness, 
capture, and mass handling response requirements. This 
results in a large range of vehicle applicability and mating 30 
capabilities. 

BRIEF DESCRIPTION OF THE DRAWINGS 

For a detailed description of the preferred embodiments of 
the present invention, reference will now be made to the 35 
accompanying drawings in which: 

FIG. 1 is a perspective view of the docking assembly of 
the preferred embodiment in the extended position 
FIG. 2 is an alternative embodiment of the alignment 
guides of the docking assembly; 

FIG. 3 is a side view of the load sensing ring of the 
docking assembly of the preferred embodiment; 

FIG. 4 depicts the projection of the load cells of the 
docking assembly of the preferred embodiment into an x-y 45 
plane; 

FIG. 5 is a perspective view of the docking assembly of 
the preferred embodiment in the retracted position; 

FIG. 6 depicts the angle of each upper and lower con- 
nection point of the load cells of the docking assembly of the 50 
preferred embodiment in reference to the positive x-axis; 

FIG. 7 depicts the x-y coordinates of a load cell of the 
docking assembly of the preferred embodiment; 

FIG. 8 depicts the x-y coordinates of the upper and lower 
connection points of a load cell of the docking assembly of 55 
the preferred embodiment; 

FIG. 9 graphically shows the meaning of “as far from 
parallel as possible” in respect to the load cells of the 
docking assembly of the preferred embodiment; 60 

FIG. 10a show's a docking vehicle entering the capture 
envelope in the preferred embodiment of the docking, assem- 
bly; 

FIG. 10 b shows the preferred embodiment of the docking 
assembly in the capture mode; 65 

FIG. 10c shows the preferred embodiment of the docking 
assembly in the stabilize and retract mode; 
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FIG. 11 shows the static guidance provided by alignment 
guides of the preferred docking assembly; 

FIG. 12 depicts the pressurized transfer tunnel of the 
preferred docking assembly; 

FIG. 13 is a block diagram showing an overview of the 
closed loop control system of the preferred docking assem- 
bly; 

FIG. 14 is an expanded view of block 13 a of FIG. 13; 

FIG. 15 shows the angle a of each of the load cells in the 
preferred docking assembly projected into the x-y plane in 
reference to the positive x-axis; 

FIG. 16 is an expanded view of block 13 b of FIG. 13; 

FIG. 17 is an expanded view of block 13c of FIG. 13; 

FIG. 18 shows the active coordinate system for the upper 
connection points of the actuators and the base coordinate 
system for the base connection points of the actuators; and 

FIG. 19 is an expanded view of block 13 d of FIG. 13. 

NOTATION AND NOMENCLATURE 

Certain terms are used throughout the following descrip- 
tion and claims to refer to particular system components. As 
one skilled in the art will appreciate, different writers may 
refer to a component by different names. This document 
does not intend to distinguish between components that 
differ in name but not function. In the following discussion 
and in the claims, the terms “including” and “comprising” 
are used in an open-ended fashion, and thus should be 
interpreted to mean “including, but not limited to . . Also, 
the term “couple” or “couples” is intended to mean either an 
indirect or direct connection. Thus, if a first device couples 
to a second device, that connection may be through a direct 
connection, or through an indirect connection via other 
devices and connections. The term “connect” or “con- 
nected” is intended to mean a direct connection. 

DETAILED DESCRIPTION OF THE 
PREFERRED EMBODIMENTS 

FIG. 1 is a perspective view of a docking assembly 1 in 
accordance with the preferred embodiment of the invention. 
Docking assembly 1 preferably comprises a load sensing 
ring 3, one or more electromagnets 4, one or more striker 
plates 5, a plurality of load cells 6, a plurality of actuators 9, 
a plurality of alignment guides 14, and an active closed loop 
control system 15 (not shown). Load sensing ring 3 has an 
annular outer face 8 and an inner face 10 (FIG. 3). The 
electromagnets 4 and striker plates 5 preferably are posi- 
tioned on outer face 8. Each of the alignment guides 14 is 
also positioned on outer face 8. In the preferred embodiment 
shown in FIG. 1, each of the alignment guides 14 is a 
foldable guide petal 17. 

The docking assembly 1 can use other structures as an 
alternative to petals 17. For example, probe and cone guides 
18 shown in FIG. 2 can be .used in place of petals 17. 

Referring again to FIG. 1, load sensing ring 3 preferably 
comprises a soft capture ring 13 and a structural ring 2. The 
soft capture ring 13 and structural ring 2 are attached or 
otherwise coupled together using load cells 6. Load sensing 
ring 3 is an active load sensing ring, meaning that load 
sensing ring 3 uses load cells 6 to actively sense any forces 
applied to load sensing ring 3, such as the forces the load 
sensing ring 3 experiences during docking or berthing. 

One or more motors 7 control each of the actuators 9. 
Each motor 7 is mechanically coupled to its respective 
actuator 9. Each motor 7 is capable of physically lengthen- 
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ing and shortening its actuator 9 to dynamically adjust the 
position and orientation of load sensing ring 3. Where the 
term “dynamically'' includes such physical lengthening and 
shortening of actuators in real time Because soft capture 
ring 13 and structural ring 2 are coupled by the load cells 6, 
dynamically adjusting the position and orientation of load 
sensing ring 3 dynamically adjusts the position and orien- 
tation of soft capture ring 13. Controller 16 (not shown) is 
coupled to the motors 7 and to closed loop control system 
15. Closed loop control system 15 and controller 16 are 
housed within compartment 22. 

In the preferred embodiment of docking assembly 1, the 
closed loop control system 15 is reconfigurable, i.e., is 
adjustable to a specific vehicle's properties i.e. mass and 
center of gravity offset and operational mating 
characteristics, i.e., approach velocities and angular rates. 
Further, closed loop control system 15 parameters are tun- 
able in each axis to various stiffness ind damping constants 
depending upon stiffness, capture, and mass handling 
response requirements. This results in a large range of 
vehicle applicability and mating scenarios. 

As described in detail below, closed loop control system 

15 receives signals from the load cells 6. These signals 
correspond to, or are representative of, the forces F, sensed 
by each of the six load cells 6 (where “i” is the number of 
one of the six load cells 6). Closed loop control system 15 
processes those force signals and transmits to controller 16 
a processed signal representing the length L s (where “s” is 
the number of one of the six actuators 9) to which each of 
the actuators 9 must move to counteract, absorb, or attenuate 
each force F,. Based on the required length L s , controller 16 
directs the motors 7 to physically and dynamically adjust 
each of the corresponding actuators 9 to its calculated Lj.. In 
general, the docking system 1 continuously monitors the 
forces F, sensed by the load cells 6 and directs each actuator 
9 to adjust its length to a calculated length to counteract, 
absorb, or attenuate the forces. 

In the preferred embodiment, for conservation of space 
and weight, a single controller 16 controls all of the motors 
7. Alternatively, two or more controllers 16 can be included 
without sacrificing the benefits of the present invention. If 
multiple controllers 16 are included, one of the controllers 

16 actively controls the motors 7, while the other controller 
(s) 16 are redundant and remain ready to be used if the active 
controller fails. Referring to FIG. 1, the actuators 9, con- 
troller 16, motors 7, structural ring 2, and platform base ring 
11 comprise a six degree of freedom platform 12. By “six 
degrees of freedom" it is meant that platform 12 is capable 
of translational motion along x, y, and z axes and rotational 
motion about x, y, and z axes (called roll, pitch and yaw, 
respectively). 

Each of the actuators 9 preferably comprises a standard 
linear actuator with a ball screw and thrust tube and has an 
upper connection point UC^ on load sensing ring 3 and a 
base connection point BC 5 , on platform base ring 11 (where 
“s” represents the number of one of the six actuators 9). As 
explained in more detail below, six degree of freedom 
platform 12 dynamically adjusts the soft capture ring 13 so 
that the residual motion between trie two vehicles being 
docked or berthed is damped and the forces associated with 
the docking or berthing process tire attenuated. 

Referring now to FIGS. 1 and 3, each of the load cells 6 
is a uni-axial compression/tension force sensor that has a 
sensing end 21 and a length L. Additionally, each of the load 
cells 6 is coupled to load sensing ring 3 at an upper 
connection point PU, and a lower connection point PL, 
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(where “i” represents the number of one of the six load cells 
6). The preferred docking assembly 1 comprises six load 
cells 6, thus i is one of the set; 1, 2, 3. 4, 5, or 6. In FIG. 3, 
the load cells 6 are positioned between structural ring 2 and 
5 soft capture ring 13. The load cells 6 are oriented at an angle 
13 relative to outer face 8 of soft capture ring 13. Preferably, 
angle p equals 45°. Each of the load cells 6 has spherical 
joints or ball bearing universal joints (not shown) at each 
axial end to allow purely axial forces F, to be sensed through 
io each of the load cells 6. As such, each load cell 6 preferably 
is an uni-axial device that senses force predominately along 
its longitudinal axis. 

Referring now to FIGS. 4 through 8, the load cells 6 
preferably are mounted in a circular arrangement. FIG. 4 is 
15 a top view of the length L of load cells 6 (in the direction of 
Arrow D in FIG. 3) projected into the x-y plane of coordi- 
nate system R, shown in FIG. 5. The preferred arrangement 
is one that minimizes the error (increases the accuracy) of 
the load computation. The circular arrangement of the load 
20 cells 6 can be determined by plotting the upper connection 
points PU, and the lower connection points PL, of the load 
cells 6 in three dimensions, namely x, y, and z, and project- 
ing the length of the load cell 6 onto the x-y plane, as shown 
in FIG. 8. Referring to FIGS. 4, 6, 7, and 8, the “x” symbols 
25 represent the x-y coordinate of each PL, and the symbols 
represent the x-y coordinate of each PU,-. 

FIG. 7 shows the chord length L a resulting from the 
projection of length L for a load cell 6 into plane XY. Chord 
length La can be written as L n =L cos(p) (Equation 1). 

30 As an example, the preferred circular arrangement of the 
load cells 6 can be calculated using the following defined 
parameters, which are exemplary values used to illustrate the 
principles of the preferred embodiment: 

35 


L = 1 .76 (inches ) Length L of each load cell 6 
r PLi = L5.00 (inches) Radius of lower connection PL, of a load cell 6 

r pui = 14,75 (inches) Radius of upper connection PU, of a load cell 6 

Xoff = 0.0 (inches) X offset to the x-axis of interest 

40 Yoff = 0.0 (inches) Y offset to the v-axis of interest 

Zoff = -4.876 (inches) Z offset to the z-axis of interest 

fj = 45.0 degrees Angle of inclination of each of the load cells 6 

relative to outer face 8. as shown in Figure 3 
k = 1.01275223 Ratio of spacing angles 

bLowlst = 1 Boolean value that switches (i.e.. acts as if the U 

^ and L connection points were reversed) PU and 

PL of each of the load cells 6. bLowlst (1) has 
Lower connection first from the X-axis 


FIG. 5 shows the preferred x, y, z coordinate system R 
50 used in relation to the load cells 6. FIG. 5 also shows plane 
XY of coordinate system R. To calculate the preferred 
circular arrangement of the load cells 6, the x and y offsets 
Xoff, Yoff are 0.0 inches and the z-offset Zoff is —4.876 
inches, a position above the x-y plane, as shown in FIG. 5. 
55 Zoff is preferably above the x-y plane because the initial 
contact occurs on or above the outer face 8 on the alignment 
guides 14. The Zoff center of force rotation is chosen in such 
a manner to minimize moments generated across the inter- 
face at the location of initial contact on the alignment guides 
60 14. This arrangement makes capture more stable. The bool- 
ean value bLowlst switches the position of PU, and PL, for 
each of the load cells 6. By changing the boolean bLowlst 
from 1 to 0 or vice-versa, the x-y position of each PL, 
switches to the x-y position of each PU; while the x-y 
65 position of each PU, switches to the x-y position of each PL,. 

Referring to FIG. 7, using the triangle formed from the 
chord length La and two lines drawn from the center of the 
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circle to the x-y coordinates of PU, and PL,, of each of the 
load cells 6, an angle 0 is calculated using the Law of 
Cosines, known to those of ordinary skill in the art. 


( r PL + r pu;) ~ La' 
i-rpurpui) 


(Equation 2) 


plane can be calculated using the angles in the arrays defined 
by Equation 6 and the following equations: 


PLx, - r PLl cos{APLi) PUy ( - r PUl siniAPU;) 
PL ,y ; = rpuiiHAPLi) PUx, - r PU! cos(APU;) 


(Equations 7) 


Due to symmetry in the arrangement of the load cells 6, 
the ratio of spacing angles k is defined as: k=\|//(|) (Equation 
3). Referring now to FIG. 4, the angle 0 formed between the 
projected length La, the spacing angle O between the upper 
connection point PU,. of each of the load cell 6, and the 
spacing angle y between the lower connection point PL, of 
each of the load cells 6 sum to 360 degrees and can be 


Accordingly, PLx,- is the x-coordinate of PL for the i rh load 
cell 6, PLy, is the y-coordinate of PL for the i th load cell 6, 
PUx, is the x-coordinate of PU for the \ Th load cell 6, and 
PUy, is the y-coordinate of PU for the \ th load cell 6. 

FIG. 7 is an exploded view of FIG. 6 focusing on load cell 
Cl and shows PLxj land PLy , , From the defined parameters, 
the connection point PU„ PL,, results are as follows: 


(Equations 8) 


written as follows: 



12.437 


7.93 




0.65 


14.736 

6(H4+3\y=360 u 

(Equation 4). 


-13.086 


6.805 
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-13.086 

PUy = 

-6.805 

Since 0 can be calculated using 

Equation 3, <J) can be 20 



determined in terms of 0 and k: 


0.65 


- 14.736 




. 12.437 


-7.93 


(120 deg - 26) 

(T7 T) ‘ 


(Equation 5) 


Now referring to FIG. 6, the x-y location of upper and 
lower connection points PU,., PL,, each of the load cells 6 are 
calculated from angles measured from the positive x-axis. 
APU, is the array of angles (where the subscripts indicate a 
particular load cell 6 as shown in FIG. 6) representing the 
angle of each upper connection point APU„ measured from 
the positive x-axis. Likewise APL,. represents the angles of 
the lower connection points measured from the positive 
x-axis. In the preferred embodiment the number i of load 
cells 6 equals six. Referring still to FIG. 6, as an example of 
the preferred embodiment, the projection La, of each load 
cells 6 is shown, where Cl, C2, C3, C4, C5, C6 denotes load 
cells one through six. 
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7.002 


-0.569 


14.989 

PL, - 

-12.697 
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7.987 

-12.697 


-7.987 


-0.569 


-14.989 


13.265 


, -7.002 


■ — + if (bLow 1 st, 9, 0) 


f = - + if (bLow 1st , 0, 0) 

\p 

2 = - + if (bLow 1 st, 9 . 0) 

\p 

» = z; + if (bLow 1#, 9, 0) 
t i '/ 
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= + + ( bLowist , 30, 0) 

ip 

= — + 24> + ^ + if ( bLowlsr , 40, 30) 
tb 

i - — + 2<1> + & + if (bLowist, 30, 40) 

tp 

= - + 20 + 2ip + if (bLowi st, 40, 50) 


- + 2<l» + lip + if (bLowist, 50, 40) 


: - + 3<J> + lip + if (bLowist, 60. 50) 


, = - + 34* + 2ip + if (bLowist, 59, 69) 


(Equations 6) 


The x and y coordinates of the upper and lower connec- 
tions points PU,, PL, of the load cells 6 projected on a x-y 


Referring to FIG. 8, the x and y coordinates of the upper 
and lower connection points PU,- and PL,- are plotted onto 
plane x-y (FIG. 5). FIG. 8 depicts the exemplary embodi- 
> ment of the position of the load cells 6 relative to one 
another. In this exemplary embodiment, each of the load 
cells 6 preferably is as far from parallel as possible with each 
of the other load cells 6. “As far from parallel as possible” 
does not mean that the cells are perpendicular to each other. 

) “As far from parallel as possible: means an optimal arrange- 
ment of load cells such that an angle between any two load 
cells is as far from parallel as possible. 

FIG. 9 shows what “as far from parallel as possible” 
means with respect to the circular arrangement of the load 
cells 6 of the present invention. FIG. 9 depicts the same 
graph as FIG. 8, showing exemplary connection points PU 7 
and PL,- of each of the load cells 6 in an x-y plane, except 
a straight line R, has been drawn through PU,- and PL, for 
each of the load cells 6. R„ the length L a between connection 
points of each load cell 6 projected into the x-y plane. For 
example, the upper connection points PU,, are all on a circle. 
The lower connection points PL, are on a different concen- 
tric circle having a larger radius than the circle created by the 
PU-. To illustrate, (still referring to FIG. 9,) if the upper and 
lower connection points PU^, PL,, lie on circles having the 
same radius, then R1 and R4, R2 and R5, and R3 and R6 
would become parallel and R1 and R2, R3 and R4, and R5 
and R6 would become farther from parallel. 

Now visualize the upper connection points PU, lying on 
a circle smaller than the circle formed by lower connection 
points PL,. The lines R1 and R4, R2 and R5, R3 and R6 are 
now no longer parallel and R1 and R2, R3 and R4, and R5 
and R6 are now becoming closer to parallel. The point of this 
example is to illustrate the arrangement of the load cell lines 
of projection to be “as far from parallel as possible” or 
becomes an equilibrium inflection point because, as soon as 
two or more R„ become farther from parallel, then two or 
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more other R„ become closer to parallel. By keeping the load 
cells 6 as far from parallel as possible with respect to one 
another, the error of the computed resultant force is mini- 
mized and, consequently, the accuracy of the force compu- 
tation is increased. 

Further, this exemplary positioning in conjunction with 
the spherical joints or ball bearing universal joints (not 
shown) located at each end of each load cell 6 provides 
sensing capabilities in six degrees of freedom and creates a 
“statically determinant” system. This statically determinant 
system allows computation of the composite forces/ 
moments using the individual forces F, sensed from each 
load cell 6. Preferably, the closed loop control system 15 can 
resolve any force F, sensed by the load cells 6 into its force 
vectors Fx,-, Fy,., Fz, having a known location, magnitude, 
and direction of application. Closed loop control system 15 
calculates a composite force vector in each direction FX, FY, 
FZ by summing Fx,, summing Fy,-, and summing Fz y , 
respectively. Closed loop control system 15 also uses Fx,, 
Fy Fz ( to calculate a composite moment about each axis 
MX, MY, MZ. FX, FY, and FZ are collectively referred to 
as F^,_. MX, MY, and MZ are collectively referred to as 
M^. Closed loop control system 15 uses composite force 
F^. and composite moment M^.. to calculate where to move 
soft capture ring 13 (and consequently load sensing ring 3) 
to minimize the contact force F, sensed by the load cells 6. 
In effect, this information allows the active docking assem- 
bly 1 to automatically comply and realign itself to the 
passive docking assembly thereby greatly reducing or elimi- 
nating the undesirable forces that conventional docking or 
berthing capture creates. 

Each of the vehicles being docked preferably has a 
docking assembly 1. Also, when docking or berthing, one 
docking assembly 1 is “active” while the other docking 
assembly 1 is “passive ” The active docking assembly 
automatically provides misalignment compliance and 
attenuation to accomplish docking or berthing. The passive 
docking assembly act as a fixed assembly. “Fixed” is 
intended to mean that the passive decking assembly can be 
either a docking assembly which is incapable of dynamically 
adjusting or a docking assembly 1 which, although capable 
of dynamically adjusting, is made temporarily incapable of 
dynamically adjusting. For example, a fixed docking assem- 
bly can be fixed by locking it in place using a soft capture 
ring lockdown (not shown) meaning that all components are 
kept stationary and no control system is required. 

Referring now to FIGS. 10a-c, the following discussion 
explains the use of the docking assembly 1 to dock two 
vehicles together. For illustration, and without limiting the 
scope of the present invention, the vehicle 100 to be docked 
is assumed to be a vehicle similar to the Space Transport 
System (the Space Shuttle), hereinafter referred to as the 
“docking” vehicle. For further illustration, and again without 
limiting the scope of the present invention, the vehicle 101 
to which the docking vehicle 100 docks preferably is a space 
station, hereinafter referred to as the ‘principal” vehicle. For 
illustration of the preferred docking system of the present 
invention, docking assembly 1 on principal vehicle 101 is 
“passive” and docking assembly 1 ori docking vehicle 100 is 
“active.” However, the preferred embodiment is inherently 
redundant because either docking assembly 1 of the docking 
system is capable of providing; the “active” role when 
docking or berthing. 

Referring still to FIGS. lOu-lOo docking vehicle 100 
must be maneuvered (either via a pilot or autonomously by 
remote control or by a RMS) into the capture envelope. 
Once inside the capture envelope, the soft capture ring 13, 


10 

by extension or retraction, can achieve soft capture with 
positive, zero, or negative closing velocities. 

Upon entering the capture envelope there are five modes 
of operation that include capture, attenuation, stabilization, 

5 retraction, and structural latching. 

During the first four docking modes, the load sensing ring 
6 on the active docking assembly 1 senses forces and 
moments applied to the soft capture ring 13. These forces 
and moments are then used in kinematic calculations. The 
results of the kinematic calculations are then outputted as 
10 position and orientation control signals to active docking 
assembly 1 on docking vehicle 100 to dynamically adjust 
active docking assembly 1. This process is described in 
further detail below. 

During the capture mode, electrical current is passed to 
15 energize the electromagnets 4 for soft capture. After entering 
the capture envelope and beginning with initial contact, the 
alignment guides 14 on the active and passive docking 
assemblies 1 dynamically guide the soft capture ring 13 on 
the active docking vehicle 100 into alignment with the 
20 passive docking assembly on the principal vehicle 101, as 
shown in FIG. 11. In addition, the electromagnets 4 posi- 
tioned on the outer face 8 of the soft capture ring 13 on the 
active docking assembly 1 are delivered to corresponding 
striker plates 5 positioned on the outer face 8 of the soft 
25 capture ring 13 on the passive docking assembly 1 of the 
other vehicle. Referring to FIG. 10/?, when all the electro- 
magnets 4 and the striker plates 5 of the respective docking 
assemblies 1 contact, the contact switches 18 are triggered 
and a signal is provided to the closed loop control system 15 
30 to change the operational mode of the active docking 
assembly 1 of docking vehicle 101 from a capture mode to 
an attenuation mode. 

During the attenuation mode. Referring to FIG. 10c, the 
residual motion is damped out and the forces are attenuated, 
35 the active docking assembly 1, under the direction of the 
control system 15, transitions first into stabilization and then 
retraction modes. 

During the stabilize and retract modes, the docking 
vehicle 100 and principal vehicle 101 must be aligned such 
40 that pressure tunnel 2 can be created, sealed, and activated. 
In many instances however, when the stabilization and 
retraction mode is begun, vehicles 100, 101 are still mis- 
aligned. Thus, closed loop control system 15 directs the 
individual actuators 9 to physically (that is, extend or retract 
45 so as to) adjust the soft capture ring 3 to achieve proper 
alignment of the vehicles for sealing and latching (shown in 
FIG. 12). Referring to FIG. 1, after proper alignment and 
seal-to-seal contact, the structural latches 19 are engaged 
and effect a semi-permanent (rigid) structural connection 
50 between the two vehicles. Engagement of the structural 
latches 19 compresses and pre-loads the pressurization seals 
20 to maintain a pressurized transfer volume. The semi- 
permanent structure creates a pressurized transfer tunnel 12 
through which persons, materials, etc. can pass. After 
55 achieving this semi-permanent structural connection, the 
electrical current is cut off from the electromagnets 4 and the 
soft capture ring on the active docking assembly is disen- 
gaged from the passive docking assembly and retracted to a 
stowed position. 

60 Separation of docking vehicle 100 and principal vehicle 
101 occurs by releasing the structural latches 19. 

The above discussion illustrates the preferred docking or 
berthing scenario. One facet of the preferred embodiment, 
which was described in general in the above illustration, is 
65 the closed loop control system 15. The following is a more 
detailed description of the preferred closed loop control 
system 15. 
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Turning first to FIG. 13, an overview of the closed loop 
control system 15 of docking assembly 1 is shown. Block 
13a represents load sensing ring 3 and the load cells 6. As 
docking vehicle 100 contacts soft capture ring 13 of the 
principle vehicle, each of the load cells 6 of vehicle 100 f 
senses the forces F,. created on vehicle 100 by the contact. 
Using the forces F,- sensed by load cells 6, control system 15 
calculates the component x-y-z forces Fx„ Fy /} Fz, of force 
F r Control system 15 then sums each x-component Fx, to 
calculate a composite force in the x-direction FX, sums each n 
y-component Fy / to calculate a composite force in the 
y-direction FY, and sums each z-component Fz / to calculate 
a composite force in the z-direction FZ. As previously 
stated, the directional composite [x, y and z] forces FX, FY, 

FZ are collectively denoted F xyz . Further, closed loop a 
control system 15 uses the component forces Fx,, Fy„ Fz, to 
calculate the moments acting about each axis — MX for the 
moments about the x-axis, MY for the moments about the 
y-axis, and MZ for the moments about the z-axis — created 
by force F, as sensed by each load cell 6. 2t 

Thereafter, as shown by block 13 b, the control system 15 
calculates the expected change in position AP^,, and the 
expected change in angle AA rpy of load sensing ring 3 due 
to composite force F xyz and composite moment M^_. Refer- 
ring to block 13c, the control system 15 uses the expected 25 
change in position AP^,., and the expected change in angle 
AA r ^, along with the previous global position PP^, and 
previous global angle PA rpy1 of load sensing ring 3 to 
calculate a desired global position DP^ C of the load sensing 
ring 3 and a desired global angle DA,.^, of the load sensing 30 
ring 3. Closed loop control system 15 further calculates the 
desired length L s of each of the actuators 9 (where “s’" 
represents the number of one of the six actuators 9), required 
to dynamically adjust the load sensing ring to desired 
position. A signal representing the desired length is 35 
transmitted to each of the actuators 9, which then dynami- 
cally adjusts to its respective L s . Finally, the load cells 6 
sense indirect load I. The indirect load I is any force sensed 
by the load cells 6 that is not caused solely and directly by 
the motion of the docking vehicle 100 or its load sensing 40 
ring 3. The indirect load I can result from many factors, 
including the actuators 9 being adjusted to their desired 
length L s or a reduction of forces caused by the movement 
of load sensing ring 3 away from the docking vehicle 100. 

The closed loop control system repeats continuously in 45 
real-time. 

In summary, FIG. 13 depicts an overview of the operation 
of the docking assembly 1 of the preferred embodiment of 
the present invention. Closed loop control system 15 calcu- 
lates the dynamic adjustment required of the actuators 9 on 50 
active docking assembly 1. Closed loop control system 15 
then directs the actuators 9 to dynamically adjust soft 
capture ring 3 to minimize, and eventually attenuate and/or 
dissipate all, the residual motion and/or forces sensed by the 
load cells 6. 55 

With this overview as a backdrop, the following discus- 
sion includes a detailed view of closed loop control system 
15. FIG. 14 is an expanded block diagram of block 13a in 
FIG. 13. Block 14a depicts the load sensing ring 3 and the 
load cells 6. As stated above, as principle vehicle 101 60 
contacts load sensing ring 3, each load cells 6 senses a force 
F, created by that contact. In the preferred embodiment, the 
number i of load cells 6 equals six. A first order lag filter 14 b 
preferably is a low pass filter which filters force F, to 
attenuate higher frequency noise. 65 

After filter 14b attenuates the higher frequency content of 
force F,-, the zero order hold 14c samples force F, at discrete 


intervals. The control system 15 then use a matnx transfor- 
mation (as detailed below) to convert force F, into a com- 
posite of three dimensional force vectors F n ._ and moments 
about each axis M^, as shown by block 14d. 

» The preferred matrix transformation is: 

FX FXoff (Equation 9) 

FY FYoff 

FZ FZoff 

) - JF; - 

MX MXoff 

MY MYoff 

MZ MZoff . 

> The constant matrix J in Equation 9 is based on the geometry 
of the docking assembly 1 and in particular the load cells 
connection points of PU, and PL 4 - and is defined by Equa- 
tions 10: 

i A.,— coslPKosta,) 

A./~cos((3)sm(a,) 

A.r=sin(|3) 

~sin( ) ■ (PUy i + Koflf )-c os( (3) • sin(a ( )Zoff 

•A. r=- sin{ ) ■ (PUXj+Xoff, )+cos( (3 )cos( a ; )■ Zoff 

/ 6 / =cos(p)-sin (a^MPC'X+Xoffj-cos 

(P)-cos(a,HPt/y J +ybfiF) (Equations 10) 

The constant matrix J is pre -calculated once from the 
geometric properties of load sensing ring 3, namely angle p 
(shown in FIG. 3), angle a,- of each of the load cells 6 
projected into plane XY (detailed below and shown in FIG. 
15), the upper and lower connection points PU, and PL, of 
the of each load cells 6, any offsets from the center axes, and 
the number i of load cells 6. 

To derive Equation 9, one should first refer to FIGS. 7 and 
15. There, the angle a,, of each of the load cells 6 projected 
into plane XY is calculated relative to the x-axis and is 
defined as: 

a,-angle(Pt/.t r PLv i ,PC/y-PLy f ), (Equation 11) 

PUx, is the x-coordinate in coordinate system R of upper 
connection point PU,, PUy z is the y-coordinate in coordinate 
system R (FIG. 5) of upper connection point PU„ PLx, is the 
x-coordinate in coordinate system R of the lower connection 
point PL/, and PLy, is the y-coordinate in coordinate system 
R of the lower connection point PL,. 

As shown by Equations 12 below, closed loop control 
system 15 calculates the x-y-z components Fx /? Fy,., Fz, of 
force F,. Further, as shown by Equations 13 below, closed 
loop control system 15 also calculates the moments Mx„ 
My,, and Mz, about each axis acting on load sensing ring 3 
based on components Fx,., Fy^, Fz, and accounting for any 
position offset Xoff, Yoff, Zoff. 

Fx; = F;Cos(/3)co$,(a;) (Equations 12) 

Fy i = FjCos(fi)cos(cti) 

Fzi = FjSin(J3) 

Mx, - Fzi(PUyr) - Fy - (Equations 13) 

My t = (-FzUPUxt) + FxiZoff 

Mzi = Fy ; (PUXi + Xoff) - FxtiPUy; + Yoff) 

Closed loop control system 15 then calculates the com- 
posite force in each direction FX, FY, FZ by summing the 
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respective component force Fx,-, Fy,, Fz ; for each of the load 
cells 6 and then subtracting any force offset FXoff, FYoff, 
Fzoff, as shown by Equations 14 below. Finally, closed loop 
control system 15 calculates the composite moment acting 
about each axis MX, MY, MZ by summing the respective 
moments Mx,, My,-, Mz,- and subtracting and moment offset 
MXoff, MYoff, Mzoff as shown by Equations 15. 


14 

skill in the art can derive difference Equation 17 by mod- 
eling by lag-lead compensator 1 6r in the s-domain: 

l + r fi[ (Equation 18) 


FX = £ Fxi - FXoff 
<>=! . 6) 

FY = Y Fy ; - FYoff 
(/■i 6) 

FZ = Yj Fzi ~ FZ °ff 

6* I ... 6) 

MX - Y Mx ' ~ MX °ff 
6=1 .. 6» 

my = y My ; - MYoff 

<j* ! .. . 6) 

MZ - ^ > - MZoff 

u'=l ... 6) 


(Equations 14) 


Further, one of skill in the art can convert Equation 18 to a 
z-domain equation by using the backw ard rectangular trans- 
form: 



(Equation 19) 


15 

(Equations L5) 

In Equations 18-19, T is sample time, x is the time 
constant from which the break frequencies are derived. 
Using Equations 18-19, one of skill in the art can derive the 
20 equation that models the preferred lag-lead compensator 16r 
in the z-domain: 


Equations 14 and 15 are combined to form six simultaneous 
Equations 16: 


FX = Yj F,cos(/3)cos (an) -FXoff 

(,t=i ... 63 

FY = Y Ficos(/3)cos(ai) - FY iff 

(i=l ... 6) 


(Equations 16) 


30 



(Equation 20) 


FZ= Y ^os(0)cos(tf ; )-FZ# 

(/= ! ... 6) 

MX = Y t [F;i>in(/3)(PUy ; - Yojf) + 

o'* i 6) 35 

F t cos( fi)sin(a; )Zoff ] - MXof 
MY = Y 1“ Fi&uUffXPUx; - Xofj ) - 

(i=l ...6) 


One of skill in the art can implement Equation 20 into a 
computer by defining difference Equation 17 above to model 
Equation 20, and thus model lag-lead compensator 16/: 

To derive difference Equation 17, one of skill in the art 
can recognize using Equation 21-27 below. 


F;c os {/?) si n( a, )Zoff] - MYoff 40 T 

Ka - =- 

_ T + t a 

MZ = Y s in(/3 ) s in( a, ) (/* C/a - Xoff) + 

6*1 ... 6) ^ _ 7* 

(-F) J cos(/3)cos(a J )(/ > (/y r - Yojf) j - MZoff T + t b 


(Equation 21) 
(Equation 22) 


One of skill in the art can place the six Equations 1 6 in 
matrix format, shown in Equation 9 above. 

Turning to FIG. 16, after calculating, composite force ¥ Kyz 
and composite moment M^.-, closed loop control system 15 
then calculates the expected change in position AP xyz and 
expected change in angle AA rpy of load sensing ring 3 due 
to forces imposed on load sensing ring by vehicle 101 and 
as sensed by the load cells 6. The blocks shown in FIGS. 16a 
and 16Z? are expanded views of block 13c in FIG. 13. FIG. 
16a shows the calculation of AP^., and AA rfy of load sensing 
ring 3 when docking assembly 1 is in the capture and 
attenuation modes, while FIG. 16b shows the calculation of 
AP xyT and A Arpy when docking assembly 1 is in the stabilize 
and retract modes. 

Referring to FIG. 16a, when the docking assembly 1 is in 
the capture and attenuation modes, F xyz and pass 

through a first order lag-lead compensator 16/ having a 
sample time of 0.02 seconds and can be represented by the 
following difference equation: 

Output! n }=GDInput( n b~G*A lnput(n- I H'5*Output(n-flEquation 17) 

In the preferred embodiment, one of skill in the an can 
implement difference Equation 1.7 on a computer. One of 


45 


H(z) = 


JfA 

[z- 0-^)1 


50 


55 


El 

K.a 


>>> G 


(1 - K a ) >>> A 
(1 - K b ) >» B 
; - .4 


H(z) = G 


Z-B 


(Equation 23) 


(Equation 24) 

(Equation 25) 
(Equation 26) 
(Equation 27) 


In equations 21-27, G is the gain in the z-domain, A is the 
60 zero in the z-domain, B is the pole in the z-domain, and K 
is the frequency variable gain. 

As one of skill in the an appreciates, to accurately 
represent the gain G in the model of compensator 16r, closed 
65 loop control system 15 calculates and adjusted gain GG by 
dividing gain G by the ratio of frequency variable gains K 
as shown in Equation 28: 



15 
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(Equation 28) 


One of skill in the art recognizes that Equation 20 can be 
written as: 

Output) 

- - = H(z). 

Input (c) 


Further, one of skill in the art recognizes that after substi- 
tuting Equation 27 for Hfz) and applying the inverse trans- 
form 


Output^) 

Inputs) 


(Equation 29) 


the result is the difference Equation 17 above, where “n” 
represents the time difference. 

Referring now to FIG. 16b , when the docking assembly of 
the preferred embodiment is in the stabilization and retrac- 
tion mode, closed loop control system 15 uses multiple lag 
filters 16/, 16c, 16d having varying break frequencies and 
multiple high pass compensators 16c, 16/, 16 g, 1 6h to 
calculate the desired change in position AP X> . and the 
expected change in angle AA The stabilization and 


retraction modes occur after soft capture of docking vehicle Difference Equation 30 ct 
100 is achieved, i.e., after the electromagnets 4 contact the 30 filter s-domain Equation 31 
striker plates 5. 

Given that many docking scenarios involve a docking 
vehicle 100 of large mass, composite force F 0 ,_ and com- //(*) - ■ ■ 

posite moment M xyz occur over a wide range of frequencies. 

FIG. 166 shows the preferred analysis of and over 35 

such a range of frequencies by utilizing multiple lag filters One of skill in the. art can co 

16/, 16c, 1 6d having varying break frequencies and multiple equation by using the backw 

high pass lag compensators 16c, 16/, 16g, 16 h. Preferably, tion 19 (above). In Equation 

lag filter 16/ has a certain break frequency of 0.125 Hz, lag time constant from which th 


retraction modes. Preferably, the number of compensators 
“m” equals four but could be more or less than four. As 
shown by FIG. 1 6b, closed loop control system 15 sums 
P m &P. xyz to calculate the expected change in position 4P 
5 of load sensing ring 3. Closed loop control system 15 also 
sums P, m AA rpy to calculate the expected change in angle 
AA rpy of load sensing ring 3. 

Still referring to FIG. 16Z?, preferrably compensator 16c 
]0 has a sample time T of 0.02 seconds, a gain G in the 
z-domain of 0.25, a pole B in the z-domain of -0.2, and a 
zero A in the z-domain of 0.9999999. Preferably compen- 
sator 16/has a sample time T of 0. 1 seconds, a gain G in the 
z-domain of 1.5 5.0, a pole B in the z-domain of 0.5, and a 
15 zero A in the z-domain of 0.9999999. Preferably compen- 
sator 16g has a sample time T of 0.5 seconds, a gain G in the 
z-domain of 0.2 5.0 5.0, a pole B in the z-domain of 0.9, and 
a zero A in the z-domain of 0.9999999. Preferably compen- 
sator 1 6h has a sample time T of 2.5 seconds, a gain G in the 
20 z-domain of 0.1 5.0 5.0 5.0, a pole B in the z-domain of 0.9, 
and a zero A in the z-domain of 0.9999999. 

As one of skill in the art will recognize, the lag filters 16/, 
16c, 16 d in FIG. 16 b are modeled by difference Equation 30. 

25 Output(n )=Output(n- 1 )+kl(Input(n)— Output(n- 1 ) ) (Equation 30) 

One skilled in the art can implement difference Equation 30 
on a computer with floating point math. 

Difference Equation 30 can be derived from first order lag 


(Equation 31) 


One of skill in the. art can convert Equation 3 1 to a z-domain 
equation by using the backward rectangular transform Equa- 
tion 19 (above). In Equation 3 1 , T is sample time and t is the 
time constant from which the break frequencies are derived. 


filter 16c has a break frequency less than 16/ and preferably 40 Using Equations 31 and 19, one of skill in the art can derive 


0.0625 Hz, and lag filter 1 6d has a break frequency less than 
16c and preferably 0.0078 Hz. The sample time of filters 16/, 
16c, 16d and of compensator 16c is the overall sample time 
represented by the zero order hold (ZOH) of closed loop 
control system 15, which is shown by block 14c in FIG. 14 45 
and preferably is 0.02 seconds. 

Referring still to FIG. 1 6b, while the sample time of filters 
16r, 16c, 16d and compensator 16c is the sample time 14c of 
the overall control loop, closed loop control system 15 slows 
down the sample time when the composite force F X>T and 50 
composite moment M 0> _ occur at lower frequencies as 
shown by zero order holds (ZOH) 1 6k, 16/ 161. Preferably, 
as the frequencies of ¥ xyz and M AT _ decrease, the sample time 
of compensators 16c, 16/ 16g, 16/i increases to allow the 
compensator to see changes from the previous sample. 55 

Still referring to FIG. 16b, one of skill in the art recog- 
nizes that compensators 16c, 16/ 16g, 16h can be modeled 
in the z-domain by Equation 20 above. Accordingly, com- 
pensators 16c, 16/ 16g, 16h are represented by difference 
Equation 17 above, which one of skill in the art can 60 
implement into a computer. 

Closed loop control system 15 applies gains 16m, 16//, 

16/?, 16# to the respective output of compensators 16c, 16/ 

16g, 16/i, resulting in a partial expected change in position 
Py nAPxyz and a partial expected change in angle p, 65 
mAA rpy of the load sensing ring 3, where m represents the 
number of compensators utilized in the stabilization and 


the equation that models the preferred lag filters 16/, 16c, 
1 6d in the z-domain: 

T (Equation 32) 


By defining 


(Equation 33) 


one of skill in the art can re-write Equation 32 as: 


(Equation 34) 


-(l-kl)z- 1 ] 


One of skill in the art will recognize that Equation 32 itself 
can be re-written as 

Output^) 



US 6,354,540 B1 


Substituting this into H(z) of Equation 34 results in: 


Output) kl 

Inputf.:) [1 - (I - kJ)z~ l ] 


(Equation 35) 


Re-arranging and applying the inverse transform to Equation 
35 results in difference Equation 30 (above), where “n” 
represents the time difference. 

To implement difference Equation 30 in integer math, one 
of skill in the art will recognize to take the inverse of kl, Ikl. 

1 (Equation36) 


[kl^l (Equation 37) 

The difference Equation 30 now takes the following form: 


Outputf/i) = Output? - l) ■ 


(Equation 38) 


Inputf/i) Outputf/i-l 
ikl Ikl 


To have the Input(n) be as precise as possible, the Input(n) 
is multiplied by Ikl. This mathematical slight of hand scales 
the Output(n) by Ikl. Therefore, to obtain the final result, the 
Output(n) is divided by Ikl. Shifts can be used for the 
division if powers of two are determined for the Ikl value. 
The resulting equations are now more easily implemented 
with integer math: 


Output^) = Output^ - 1) + InpuU'i) * 
OulpuK/i - l) 

Ik! 


The Output^) 


Outputf/i) 
' Ikl 


global position PP Kyz and previous global angle PA r/ , v of load 
sensing ring 3. Closed loop control system 15 calculates the 
desired global position D? xy: by summing the expected 
change in position AP a> .. and the previous position PP 0 ., of 
load sensing ring 3. Closed loop control system 15 also 
calculates the desired global angle DA rpv by summing the 
expected change in angle AA rpy and the previous angle PA r/ , v 
of load sensing ring 3. DP^- and DA r/ , v then pass through a 
rate limiter. Rate limiter 17a limits the rate at which the load 
^ sensing ring 3 can move. Thus, in the case of large loads, rate 
limiter 17a prevents the load sensing ring 3 from moving too 
fast. Therefore, saturation of actuators 9 is prevented. 

After calculating DP A> ._ and DA r/JV , closed loop control 
15 system 15 uses Equations 47 (below), depicted by block 
17/7, to calculate the x, y, and z coordinates in coordinate 
system R n to which the upper connection points UC 5 of each 
actuator 9 must move UC/ (FIG. 18) to achieve the desired 
global position DP^,_ and the desired global angle DA rpy of 
load sensing ring 3. Preferably, the number “s ’ of actuators 
9 equals six. UCx^ UCy' 5 , and UCz’ s are the x, y, z 
coordinates respectively of UC^ in coordinate system R,,. 
One of skill in the art can calculate the length L, each 
-5 actuator must move given the new 7 upper connection points 
UC’ T of each of the actuators 9 in the active coordinate 
system R„ and the base connection points BC^ of each of the 
actuators 9 in the base coordinate system by using the 
30 following equation: 


(Equation 41) 


(Equation 39) 


(Equation 40) 


y](UCx J x - BCx s ) 2 + (UCy' s - BCy s ) 2 + {UC:' - BCz*) 1 


Notice Input( n) is not really scaled upwards, it is just not 
divided by Ikl. The only history storage requirement 
between update cycles is the value Output. Thus, closed loop 
control system 15 only needs the previous output value 
Output (n— 1) to calculate Output(n). Control system 15 
applies gains 16m, 16a, 16/?, 16</ to the output of each 
compensator 16e, 16/, 1 6g, 16/?, resulting in the expected 
change in position AP at _ and expec ted change in angle 
AA W . 

Referring to FIGS. 17 and 18, in the preferred 
embodiment, after the expected change in position and 
expected change in angle AA rM> , of the load sensing ring 3 
have been calculated, closed loop control system 15 calcu- 
lates the length L s (where k ‘s” is the number of one of the six 
actuators 9) that the length each of the actuators 9 must be 
moved to attain the desired global position DP^,. and desired 
global angle DA rpy of load sensing ring 3. 

FIG. 17 is an exploded block diagram of the “Kinematic 
Control 6DOF Platform” block in FIG. 13 and depicts the 
method for calculating DP A> ._ and DA W . FIG. 18 shows the 
active coordinate system R n for the upper connection points 
UCj the actuators and the base coordinate system R b the 
lower connection points BC^ of the actuators. 

In calculating L,, closed loop control system 15 uses the 
expected change in position A? xyz and the expected change 
in angle AA of load sensing ring 3 as well as the previous 


In Equation 41, BCx^, BCy,, and BCz v are the x, y, z 
coordinates respectively of BC y in coordinate system R^ To 
points on the active plane can be translated back to the base 
40 coordinate system using the principle 3-D rotations equa- 
tions: 

X-axis of rotation: 


UCx' s =x cos(<J )-y sin(c) 


UC\’=x sin(<j)+y cos(a) 


(Equations 42) 


50 Y-axis of rotation: 


UCx'=x cos(kH-c sin(X) 


UCz' =-Asin(x)+c cos(k) 


Z-axis of rotation: 


UCy'=y cos(v)-c sin(y) 


UCz' s =y sin ( 7 )+- cos( 7 ) 


(Equations 43) 


(Equation 44) 


Rewriting the principle 3-D rotations Equations 42-44 in 
matrix form: 
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X-axis of rotation y-axis of rotation Z-axis of rotation (Equations 45) 

cos(cr) - sin< cr) 01 cost A) 0 sin(A) [1 0 0 

sin(cr) cos(cr) 0 0 10 0 cosfy) -sin(y) 

0 0 1 -sin(A) 0 cos(A) a 0 sinCy) cos(y) 


General three-dimensional rotation of the point in a 3-D a first androgynous docking assembly rigidly attached to 
coordinate space can be written as the composite of principle J0 the first object, wherein the first androgynous docking 

rotations, that is, apply a sequence of principle 3-D rotations, assembly is configured as a passive component, and 

one after the other. A composite of a general 3-D rotation is a second androgynous docking assembly rigidly attached 

given by the matrix multiplication of the three pnnciple 3-D to the second object, wherein the second" androgynous 

rotations and results in: docking assembly is structurally identical to the first 

(cos(cr)cos(A)} (cos(cr)sin(A)sin(y) - sin(cr)cos( 7 )) (cos<r)sin(A)cos(y) + sin(tr)sin(y)) 1 Equation 46 

(sin(<r)cos(A)) (sinf<r)sin(A)sin(y) + cos(<r)cos(y)) (sii*x)sin(A)cos<y) - cos((x)sin(y)) 


-sin(A) cos(A)sin(y) (cos(,l 


The general 3-D rotation of the points with x, y, z desired 
translation can now be written directly as: 

UCx UCx s cos( a )cos(A )+UCy s ( cos(cr )sin( X )sin(Y)-sin( a )cos(y))+ 
6 r C- J (co^<7)sin(A>cos(7)+sin(<T)sin(y)>-(-f)P-v i 

UCy' s -VCy I sin(a)cos(A>+t/Cy J (&jn(a)sin(A)sin(Y>+cos(a)cos(Y)>4- 
4/Cc 5 (sin(o)sin(A)cos(Y)-cos(a)sin(Y)H-D/ > v J 

UCz UCx s )sin(\)+UCy s cos( A)sin 

<Y y+UCz, cos(A)cos(y y+DPz, (Equation 47) 

Given the new upper connection points UC’^ for all axes 
and given the base connection points BC S , one of skill in the 
art can calculate the desired length L s that each actuator 9 
must move using Equation 41 above. 

Referring now to FIG. 19, having calculated L,, closed 
loop control system 15 then dynamically adjusts each of the 
actuators 9 to its calculated through closed control loop 
19e within closed loop control system 15. FIG. 19 is an 
exploded block diagram of the “Linear Actuator Servo 
Control Loop” block in FIG. 13. Preferably, loop 19 has an 
update rate, as shown by zero order hold 19 b. Lag filter 19 a 
can be modeled by difference Equation 30 above. 

One of skill in the art can implement difference Equation 
30 into a computer. Using the input of L, into closed loop 
1 9d and using difference Equation 30, closed loop control 
system 15 dynamically adjusts each of the actuators 9 to 
achieve the desired global position DP and the desired 
global angle DA r/ ^, of load sensing ring 3. At each update 
interval, length feedback 19c is fed back through closed loop 
19 d. Length feedback 19c informs closed loop 1 9d of the 
present time length L Ps of each of the actuators 9. When the 
actual L Ps of an actuator 9 equals the desired L, for that 
actuator 9, the closed loop 19 d holds the position of that 
actuator 9. Accordingly, when L Pr equals L s for each the 
actuators 9, the closed loop I9d holds the load sensing ring 
3 stationary. 

The above discussion is meant to be illustrative of the 
principles of the present invention. Numerous variations and 
modifications will become apparent to those skilled in the art 
once the above disclosure is fully appreciated. It is intended 
that the following claims be interpreted to embrace all such 
variations and modifications. 

What is claimed is: 

1. A docking system for effecting a structural connection 
between a first object and a second object, said docking 
system comprising; 


:y» 


androgynous docking assembly and is configured as an 
active component for structurally engaging the first 
androgynous docking assembly. 

2. The docking system of claim 1 wherein the first 
androgynous docking assembly, configured as the passive 
component, is fixed and incapable, at least temporarily, of 
dynamically adjusting. 

3. The docking system of claim 2, wherein the second, 
30 active, androgynous docking assembly comprises; 

a load sensing ring, said load sensing ring further 
comprising, 
a structural ring, 

a soft capture ring having an outer face, and 
35 a plurality of load cells positioned between said soft 
capture ring and said structural ring, said load cells 
producing electronic signals in response to, and 
representative of, the magnitude and direction of 
reaction forces imposed on said soft capture ring by 
40 contact of the second androgynous docking assem- 

bly with the first androgynous docking assembly. 

4. The docking system of claim 3, wherein the second, 
active, androgynous docking assembly further comprises; 

a closed loop control system capable of analyzing the 
45 electronic signals produced by said plurality of load 
cells and of outputting real time control signals, and 
a plurality of actuator arms for dynamically moving said 
soft capture ring into a desired position and orientation 
with respect to the second object in response to the real 
50 time control signals. 

5. The docking system of claim 3 wherein the plurality of 
load cells are positioned at an angle of about 45 degrees 
relative to the outer face of the soft capture ring. 

6. The docking system of claim 3 wherein each of the 
55 plurality of load cells is positioned as far from parallel as 

possible relative to each of the other load cells. 

7. The docking system of claim 4, further comprising: 

a plurality of motors, at least one motor coupled to each 
of said plurality of actuator arms, whereby said plural- 
60 ity of motors lengthen and shorten said plurality of 
actuator arms in response to said real time control 
signals to dynamically move said soft capture ring into 
a desired position and orientation. 

8. The docking system of claim 1 further comprising at 
65 least one contact sensor coupled to said load sensing ring, to 

detect physical contact of said second androgynous docking 
assembly with said first androgynous docking assembly. 
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9. The docking system of claim 4 wherein said closed loop 
control system of the second active docking assembly is 
adjustable, said adjustable closed loop control system 
capable of being varied to match the physical properties of 
a particular first object to be mated, said physical properties 
comprising one or more of the first object s mass and center 
of gravity offset. 

10. The docking system of claim 4 wherein said closed 
loop control system of the second active docking assembly 
is adjustable, said adjustable closed loop control system 
capable of being varied to match :he relative dynamic 
properties of a particular first object to be mated, said 
relative dynamic properties comprising one or more of the 
first object’s approach velocity, and angular rate relative to 
the second object. 

11. The docking system of claim 10 whereby a structural 
connection between said first and second objects may be 
effected whether the first object’s approach velocity relative 
the second object is positive in magnitude, negative in 
magnitude, or zero. 

12. The docking system of claim 4 wherein said closed 
loop control system of the second, active docking assembly 
is tunable in each axis, said tunable closed loop control 
svstem being capable of varying one or more stiffness and 
damping constants to satisfy desired stiffness, capture, and 
mass handling docking requirements. 

13. The docking system of claim 3, wherein said second 
androgynous docking assembly further comprises: 

one or more electromagnets positioned on the outer face 
of said soft docking ring capable of mating with one or 
more striker plates on said first androgynous docking 
assembly, and 

one or more striker plates positioned on the outer face of 
said soft docking ring. 

14. A fully androgynous docking system, comprising: 

a first docking assembly capable oi mating with a second 
docking assembly; 

a second docking assembly structurally identical to said 
first docking assembly, said first docking assembly 
comprising; 

a load sensing ring; 

a plurality of load cells coupled to said load sensing ring, 
each of said plurality of load cells being capable of 
sensing forces imposed on said load sensing ring by 
contact with said second docking assembly and gener- 
ating electronic signals representative of the sensed 
forces; 

a plurality of actuator arms coupled to said load sensing 
ring capable of physically and dynamically moving 
said load sensing ring through six degrees of freedom; 
and 

a closed loop control system coupled to said load cells and 
capable of analyzing the signals originating from said 
plurality of load cells and of generating real time 
control signals whereby said plurality of actuator arms 
move said load sensing ring through six degrees of 
freedom. 

15. The docking system of claim 14 wherein said plurality 
of actuator arms are lengthened and shortened by a plurality 
of motors in response to said real time control signals from 
said dosed loop control system to move said load sensing 
ring through six degrees of freedom. 

16. The docking system of claim 14 wherein said load 
sensing ring of said second docking assembly further com- 
prises: 
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a soft capture ring having an outer face; 

one or more electromagnets positioned on the outer face 
capable of mating with one or more striker plates on 
said first docking assembly, and 

5 one or more striker plates positioned on die outer face of 
said soft capture ring. 

17. A docking system for effecting a structural connection 
between a first object and a second object, said docking 

iq system comprising; 

a first androgynous docking assembly rigidly attached to 
said first object; 

a second androgynous docking assembly rigidly attached 
to said second object, 

15 said first and second androgynous docking assemblies 
being structurally identical, whereby, 

a structural connection may be effected between the first 
object and the second object upon contact of the first 

20 docking assembly with the second docking assembly. 

18. The docking system of claim 17 wherein the structural 
connection between said first and second objects may be 
effected whether the relative motion between said first and 
second objects is positive in magnitude, negative in 

25 magnitude, or zero. 

19. A method of docking a first and second objects, said 
first object having a first androgynous docking assembly and 
said second object having a second, identical, androgynous 
docking assembly, comprising the steps: 

a. extending a portion of first docking assembly into 
contact with second androgynous docking assembly; 

b. sensing a plurality of forces imposed on first docking 
assembly by contact with second androgynous docking 

35 assembly; 

c. assessing the magnitude of each of the plurality of 

imposed forces; 

d. determining, from the magnitude of the plurality of 

4 q imposed forces, the relative position and angular ori- 

entation of the first object with respect to the second 
object; 

e. computing dynamic control signals required to effect a 
desired relative position and angular orientation of the 

45 first object with respect to the second object; and 

f. applying, in response to the dynamic control signals, 
forces on the second object to move the first object into 
desired relative position and angular orientation. 

20. The method of claim 19 whereby the step of applying 

30 forces on the second object comprises the further steps of 

counteracting and absorbing forces imposed on the first 
object by the second object, and 

attenuating residual forces between first and second 

55 objects to bring them into the desired relative position 
and orientation. 

21. The method of claim 20 further comprising the step of 
attaching the first object to the second object by activating 
electromagnetic devices on the first androgynous docking 

60 assembly. 

22. The method of claim 20 further composing the step of 
attaching the first object to the second object by activating 
electromagnetic devices on the second androgynous docking 

.. assembly. 

0.5 


* * * * * 



